


Institutional Archive of the Naval Postgraduate School 


Calhoun: The NPS Institutional Archive 
DSpace Repository 


Theses and Dissertations 1. Thesis and Dissertation Collection, all items 


1992-12 


A surface integral algorithm for the motion 
planning of nonholonomic mechanical systems 


Anderson, David P. 


Monterey, California. Naval Postgraduate School 
http://ndl.handle.net/10945/24061 


This publication is a work of the U.S. Government as defined in Title 17, United 
States Code, Section 101. Copyright protection is not available for this work in the 
United States. 


Downloaded from NPS Archive: Calhoun 


Calhoun is the Naval Postgraduate School's public access digital repository for 
| (8 D U DLEY research materials and institutional publications created by the NPS community. 
«ist sia Calhoun is named for Professor of Mathematics Guy K. Calhoun, NPS's first 


NY KNOX appointed — and published -- scholarly author. 

ia) LIBRARY Dudley Knox Library / Naval Postgraduate School 

411 Dyer Road / 1 University Circle 
Monterey, California USA 93943 





http://www.nps.edu/library 


i] 
Aa 
‘ 9 
Ata 
5 
6 
e 
J 
$ 
as 
v6 
4 
*? 
as 
r 
e 
2 
on 
Va 
” 
a 
s 
® 
+ 
e 
day 
‘ 
4 
e 
"ae 
« 
> , 
, 
at 
a 
. 
6 
es at ae 
° 
‘ 
> & 
a 
. 
J 
. 
q i 
‘ 
‘ . 
s 
. 
# 
4 
¥ 
’ a 


H 
. af 
a 
) 
3 
Ss 
a | 
a 
: 
s 
ot 
pe 
of . 
‘ ¢ 
: 
4 
% 
rood 
4 
} 
b ‘ 
s 
> 
’ 
» 
‘ 
rf 












































































































» 24 slous P| SF y. Seo nates) # i ae ae = 
PY Gees i A 4 4 Reade} a6 4) he Oa b 
bady Lire s & we i) 6 re 1 at | 
y » WR e 5 a, i bi @ Uno we FE Yak y 
ss aA. ‘ ai is i \ ms ra ©}! j 
4 5 A, 4 ub i 98 (ve a2 é i i i tl . 
= ge te tape ag i . = yc™= il =— 
. te . ii. ! = As x 
18% a a aa ’ * > =I ae »? 
a et a Pari ‘1+ 7 I AAR & 
& ve ‘ 2") tTeha 8 1 , == 5 et ar 
as ane i a 4. j L. an Be Ce 
ey ee a | : ee i 4.) ; i a epA bh ae 
Ny a 4 a Le 2» 
: Pi ‘ o@ i 4 sdete i Fy. 3 Oia e a 
LY 4 ls ! Ra ant be ies 
: Lat? | Ps ate BA = Mah aea,d a be 
tha. s AP -a 8 bala oH» = — Ca Ye oe oe vw 
a? 2 % I ol a) Se 
rye = ga %> ~ ~ 9 Fe pl Fe es as 
“ —= ee Aan rh ‘ * os @¢h  VeT DT me ieanl 
a b uh ey 16 , a's a! ey wi aA 'Y 
4 4 a & & sf oo ? H ' t . 
| % oat ET ate i ‘a ah es A yy On eet oe 
i #4, t » he ff ad j il ii eg pe 
UE ) wh oe ; 7 Wed’ ‘Sas 4 = 4 beh Qodan Veday as Nate Fe 
4 ”. eh kai 4 fis i = eee 6 SRS VBS Ie ata: 
Ce : Y mel rr 4 2 i a 5 ‘ eo Whe err ww be 4 oa. 
. bo *4 o . Y B® Ome a ] I o a ” a 4. 
a a one ‘oly sense? pad a : als Cree Un 3b pone 
r) ® aot : if a (nee ia @ een’ x 
sft * ’ Bi: mh ‘4 ah a ae ) 
i ’ x 
a + re . o# ex. eee, oe ee Lae t% 
4 / ry 4 a) LA A, = % Brosyrs ¢ wa 
ae a | ro =” V 9 J =>) c= ts wash Wy Pimareer a nk 
sw 1s et re eT Shu gh Ath > 
i >’ : ‘4 het 0 @ 1b a aw | ita. or » 9,9 0.0 se: HES arty 83 
f Wis ee a Pa s tae we wa tol te Mgt ta tee nih Ach 
y 8 688 . ’ a eft "5 A! aes 4 mab ¢ +a, We Y 
* 7 = ; “ om I oe G8) iG ah onbs fda Pade 
@% 5 ° » Re e » > & -_ rs a i 
a ‘ ' 4 a Pie 2 tom 930 FD 8 be ® qe wry ss : 
1 a 1) Dome er) /, yw + ah A  tadten: Raa, C) Gece Mem. fo 
e aA ue 7 ee | SY] m Bs abl ae 7 va oS ae aeMar Me tee ar » 
a | ' @oyes ’ £ - oe ae , oe = at 4 1 roa Sea ae ‘aie Nase. oekee rts % 
a Bs se o, 4% Lb 5 7 a en oe nl d eh: ie 
‘ i ety fee! Steel i! gia a mass) 4+ a, naa - oe teas ae aaa 
’ = a 7 = ss ° s oat ‘ rs ee. A] amr a 
' Zz af Likes nal, * a.4 i ‘ i ® erate ‘! Ls % stat , an} Pte wrk, Cur ae ® rs 
>a Ame a a= 5 rei eit > +68 #t 4.9 Hahn a beng j > perm re 
A eos FF gel ee a iy ge ae pewed a. r Sec itera ae, Eessey 
a Lie “ rT 1 ve | ra ah i i 1 *, La Wha. 0 he ofa 
» s » oe a 0%, - _ - 8 : ~ mate aap er hem xen rao 
* 4% , i oe? @ re ee ee ' z= ge OS Dime OA Beh b'ghe ee hy. vee ny 
Pe ne Poy een rs we We Pe Soke ve eoaongee lls 
. oa «et + £h fee whee SB 5=* Sa: Ee? SSL ee 
ot & oh of j tp 2s Bal & ) 00.400, al ‘ana ipa a. 
ail , a * ak 4B Abe i ¥ mete Ay pits Vas Bigeye 
t ie a4 i 4 wie ae ee od 6 sre Hee eR a * Sa tas DRED dee he be iy 
, 8 ‘> mal fipa ” ) ~ at oe WNL Soe ape Bra <o8.2 Saft 
i sop im te ee ee ee ee eS ew prea: d ug baie een naa x) te evehp & 
ie. seo! . Bom a 4 es opt # wn i= * Rohde nda heere aoa a Neale Poeietl 7 
oo) *8 ai s u 4 @ % Pe: ma tyaw mone ul tens, ae PATEK F ead en kh ea eT red af parte ate 
, Pee ae , » “eho eS SS n> DS s Woy “a yas O10 =e oe oe Mabie et. pyro, 6 wed Recta gage 
ee) l Jas Ae ke ~ea ged cota bob ale, sacl yracy ara? wha > Pe 60 die wed Re ne os chien % Ps Re, 
oi } s) ‘ee et ee A # open » pk a) & afin a > Mt? I Se, 26s ek A/a phe ae oh, oe ee 4 
1 mm, & > tA. Ry a bee 5 A Ps he uh, ler a . sea racy” Lary 
»s » Ta 5 .- foam DA ” h iy conte ; nial bea bene 
Sie ar a a i] s oo 8 bho we rh 34 AIL wh > Caterer » irre parte 8h = 
s - 1 meq, 4 a wm be hy gy es i ee SeF WP JOD es Gai 4+ hover 2 vpn tome te pr an ae 
} ee | - 3 - ta few 405 Y ete® 4rthrte > eo | wo up tatnlaohied shot) bnOrmes Seat A) Movbslseayhs id plies ters conse Some, 
» 3 = 2 * Tei aie rT » ee Re eh A i dy AA Ate M a-o8 ». 7I9- Ons Ol ah e Apes “th us pene ta 7 ar psonencrcron pore sonra -veseGe Bh 
4 iy mt a 5 Pere a “ain mAs ee atone piteq oi ms wy adhe! » mon eet) ee Ts eh sen. foo Ram we 800 ate 
2 @ & 4 «4s 9 nov a & bhi dk, &D tw ot san rp Pe Pie Ur & a vieesbar ade sper. rk Lp ene A vpareee mniaipaets worare. fs. , ote 
on} as re Yoh ang pa: ow i TEMIR | ONs pikes ay ae % “6 Se Away whew  yoacd reel as pee. meaee 
a Vv . > 1 PR an cha we J ote! bork} aa eee th! gakitee ae Re pie Riork ae 
i¢ a ioe fhe o> so i a. ee ' Babee. Ma ie in : 
a 1 ree oN > Jie Wb Me ye, tray 4.0, age = & ae “4 mtr Wiz p= rhe 
4 . a o> & is Dae, | os aooig Vs wel seve d tr - pees ROR See RM Reek 
ar oe » ou -' &» Qe y a? et ges wed nah are MA ited Jara ta Ad ey wa 
» ® , P) % OX ap Gm a yrlacy Nobrgs % Ye a x ‘weg Aap a0 9% ped fee “get 
< P = ie 2 yo me epie, as fe ON vale pt pac ee’ Nig hie nm Bae ned 1 ral Pie <> rad 
> 4 ° a or = Sl i * a £ tom % = Se ‘ty. "on Ses bie > & my by mete Stews i Oe» bo 
> af 6 : xa. = * . ee a x eare © ar hem se we ”» a: 
‘oe . . ry ye ; me as Ty Ge Shel ay fatto: anh fared te hy aS ed ms 0; 
7 3 , ie! : ea, & wade roe AS oe No Sef ste Mgt rohee ‘i hey ps 4 
i ' a 4 ‘ “> ry 1 & » ge & ankle Be ‘a mh - 9 © FP eean ab ma 
me te | ei i . ia & me mah pas Be = ve 3% . & iq 
ws 4 a te * ° rs ,* Boge d A Erk Amite pes RM, | i 
tee A o © = if o* 2 ra 8 Os ’ ek 4 Ay behets se 
te re | rae f ir ar en i JO Ut ee ee 
om Ms 4 ; we a - * aie it P donate | win 
* Mi ° pts Y _™ ee } i® atage a 
i eee | au > a #51 ben a eee 24 = = = 
> ‘ } ag ' : sty * ° jek Meni = 
fs > A -— 4 » we 1 ad oe Om 
. . m : © aR 5 _ 2 . ; ¢ ‘a ait, re a Sam pane 
4 i ae 6 a 7 ol po y i) 
‘ 45% ye wae me ro a 
. zs ; on “ f a - . =a 4% Bat i “se aie 
5 * # 9° 2: 4 
ees ‘ ‘ i, °, ’ uv ’ =\"8 a oy oe ‘ 
a oe ig ogi | « af thee hte 
ave ? os ¥ PY a al 4 o Aw - 
ate a’ # 1¥ ie AS 1 » ‘hf 
+a, 04 oi i as | s ats ~ ie ae ‘ Fm % 
> "a0 re 08 a ff A ® i i 2 
- a 3 > | ~ « Foe UD ‘ ré fore o.6 fis a 
‘ * oe . 1. #22 os 23 
C7 + i ‘=—4% TY 
rh * Rey bh , 3 a 1 a ’ 
d * iat 
Ad ’ yy a q 2 v4, i = 4 ; x 7” Pile F a AN 
F F -. a 1 ? er op ay i a Soe os 5 J *. 
a z Pad ‘, ; lis doe Dip ey 8 "dal 
. - 5 " . » >° 7” ne | te\s iad, 
al ~_ h Pad * o hin Sh) s 
? er te) ata L a ls ae 4 Ane 
o> 54 » yrte thes +> * 5: es A pe venues | 
? ae ut cy ok. Pp muy: Hi tat“ + aa 
\ rt 4 ~ oak} i re 
. r.} A “We ne | i A ;. ry ee ¥ : at’ 
5 ‘ 1 , > bol a ry tr t | «', in 
4 * , vs 
: F t ’ tA * ] * t 2 
iE be . \ 1 ; ¢ . My , 4” . 
y rv 1 ¥ ily A ot ei ? werd t 1 
ae ae ne ‘ oe Af i! i ‘ 
. a 2 at - a 
. ; ; F al i » * =) i 
A) - 5 : ‘ ' oa mat 
- a, ced . ’ 4. 
ad ir ' e $ bg \" Le ‘ © ‘ A ile 7 
4 —"y, J ry is pare Sa k 
* : t ame Cs : / 7 37) ¥ 
1 5 re 'z st 2) a5 Late 4yn «i! aNd ir 
e Ee . 5 5 ‘ age i fj if =, | ap 
4 r ‘a ae rs Coes » i Vie 
u® ary! ‘4 
ws a i ‘ & Piet = ; J } aft F 
i “ eo & ! s . 
’ , i] ‘ id ‘ « a=. . ‘ 
‘ hd Pil nr ~ \f. . 1 
® + a¢ et ~ Ss eet = 
Z ¥ ¥ “6 Yr | > 
> a ‘ ‘ * ste ~ rs 
L 4 4 Hi a ‘ ' ff 7% n 
+f * ' } Fahy v VL et 1 ' 1 x 
4 7 . : hes ee. eq ae 4 
— : . ¢ oda yy Oe: 
ra a? al ‘a a ‘ me ; 4 a, 
bs $ mts? ia 1 a] Po | of Pe 
ote UP = f. i oe a % id ” 4 7. soya 
% “ ” - + 1 Y a 
Fe i 3 b :} 4 ~ Lv _* i " wo on 
: i . “a 
ie s y es v $ i * ae : J (Te 14 ’ os 
- : ST acs Lae iy ep) 7, en oe ‘t 
ae i Heche 4 : fens es yr : 6% I % * Pot J iv 
> lore “fh oy) : Me wood ie 
wed 4 i r} . ie 4 ff ero Tia 5 if 
“ a. a 7 Bs fs y, ee Wey toay> J 
4 A , 9 % 1 rY vw te 1 ae 1 i i ! g 
. ry ’ v vi ’ i Were Py 4 3 J re , on i ay 
t } ee E os ll or a « +} ? 1 pm) Gas - %y 3 , . 
ws bie 4 I 7" ? tu, % = 1 i ’ ry Be “a8 
i) ’ Ts“ ’ | 
? . ’ + F ; 7 vir 
ee Te wet 4 % > BJ iat a odie Syed we rr 4‘. 
bi 4 a = ‘ “4 i t ~ 7, se 1 , =—foia 
: x ‘ e ¥ Ee I oh as $8. wa Be a a re 
° ' . . ae Sho i da u i? ra} ° oe 
1. an i, 4 ib fe ry 7 L Foto ls ’ 
y Pr 4 ry 4 r ‘ = var 4 : 4 
7 z + . ‘ Cove? ~~ i i g. 2?) C4 
. ey UO ed J leet ee Soa ee 4 + ) ayes 
‘ i wid s i ” le eat * ay, 9) me! i #0 
£ a _ = 2, 6 = o° as ween? ae et 
e 4% * ' “ a > dee | TL A ', ? 
‘ 4 F ead fo #7 * a’ ¢% Fat 4) 
uo , ; CF Fer tye FF 15, $e ls! f 
ome 7 i a — J 
‘ ste A P “ ep oy) 7 has fk ve bye yds 
1 © «2 ¥ e 6 , [o%s sf 7 TL ese | yet oe ¥ Ke 1 
ee Ba Pets . Md dee at et = es: aati nee 
‘ i a ' Pie vee ug Re ob et f a 
‘ ' eit » : 1. ome Alter yg? r-G + Ht AD ; ; 
> * os os, 4 ay 4 > 5 1 3 rf i 
2 ¥ 2 . ‘4 « 4 ca 
’ 4 4 3 Wart age See es heer we, ft sony PEO oe ik 3 ata ieee 
ie . i rf Jo F Gb Le why,* oats a} iy ¥ : te"; te ty ma 
1 © ' _ ees oa i af@ vw . a Bea at le ead 7 } ‘te si eee 
x " oA j a as 
v 7st a) ; ee tofe Sty os LENS aD 
Ley i =o de Pal 
4 














* Fh, or rst Say 
aig 














tyre : 5 
ea tt Saw , ‘ 
Naber 
“opr ay (ele P AE Sete wR tem 6i0 20 


oa rare, nies 


5 Aut ag waite keel Nd dona ’ oo 
r. aw 


vies ¥ vag, bate 


ae cao 
r 0% 709, oe aie Ye aan Para tie Lo 
arate , te ah, f a oan * see iene ” ian 
oo pi a = ‘es ae am we oon we Waring a sata 
es id 


* ee fj <nhpd aes 


By eee ee = 


Peres 


pa aan “ 
; st y 











Unclassified 
SECURITY CLASSIFICATION OF THIS PAGE 


REPORT DOCUMENTATION PAGE a. | 


1a. REPORT SECURITY CLASSIFICATION lb RESTRICTIVE MARKINGS 
Unclassified 
2a. SECURITY CLASSIFICATION AUTHORITY 3 DISTRIBUTION/AVAILABILITY OF REPORT 


Approved for public release; distribution 1s unlimited. 
2b. DECLASSIFICATION/DOWNGRADING SCHEDULE 
















4 PERFORMING ORGANIZATION REPORT NUMBER(S) 5 MONITORING ORGANIZATION REPORT NUMBER(S) 









6b OFFICE SYMBOL 
(If applicable) 
34 







7a NAME OF MONITORING ORGANIZATION 
Naval Postgraduate School 


6a NAME OF PERFORMING ORGANIZATION 
Naval Postgraduate School 











6c ADDRESS (City, State, and ZIP Code) 
Monterey, CA 93943-5000 


7b ADDRESS (City, State, and ZIP Code) 
Monterey, CA 93943-5000 








8a. NAME OF FUNDING/SPONSORING 
ORGANIZATION 


8b. OFFICE SYMBOL 9 PROCUREMENT INSTRUMENT IDENTIFICATION NUMBER 
(If applicable) 


Bc ADDRESS (City, State, andZiPCode) 10. SOURCE OF FUNDING NUMBERS 


Program Element No Proyect NO Task NO Work Unit Accession 
Number 


11. TITLE (Include Security Classification) 


A Surface Integral Algorithm for the Motion Planning of Nonholonomic Mechanical Systems 


| 12. PERSONAL AUTHOR(S) David P. Anderson | 













13a. TYPE OF REPORT 
| Master’s Thesis 
16. SUPPLEMENTARY NOTATION 
The views expressed in this thesis are those of the author and do not reflect the officia! policy or position of the Department of Defense or the U.S. 
| Government. 

17. COSATI CODES 1B. SUBJECT TERMS (continue on reverse if necessary and identify by block number) | 


FIELD GROUP SUBGROUP | Holonomic, Nonholonomic, Scleronomic, Motion Constraints, Degrees of Freedom, 


po | Generalized Coordinates, Motion Planning 


19. ABSTRACT (continue on reverse if necessary and identify by block number) 


13b. TIME COVERED 14. DATE OF REPORT (year, month, day) 
From March 92 To December 92 December 92 





15 PAGE COUNT 
oF 





The number of coordinates needed to completely describe the configuration of a holonomic mechanical system is equal to the number of degrees of 
freedom possessed by that system. In contrast, nonholonomic systems always require more coordinates for their description than their are degrees 
of freedom due to the nonintegrable nature of the governing velocity constraints. The task of nonholonomic motion planning applied to a given 
system is to develop trajectories of the independent coordinate variables such that the entire system is driven to some desired point in its 
configuration space. An algorithm for constructing these trajectories is presented. In this algorithm, the independent variables are first converged 
to their desired values. The dependent variables are subsequently converged using closed trajectories of the independent variables. The requisite 
closed trajectories are planned using Stoke’s Theorem which converts the problem of finding a closed path in the space of the independent 
variables to that of finding a surface area in that same space such that the dependent variables converge to their desired values as the 
independent variables traverse along the boundary of this surface area. The use of Stoke’s Theorem simplifies the motion planning process and 
also answers important questions pertaining to the system. The salient features of the algorithm are apparent in the two examples discussed: a 
planar space robot and a disk rolling without slipping on a flat surface. 


20. DISTRIBUTION/AVAILABILITY OF ABSTRACT 
A UNCLASSIFIE D/UNLIMITED | T SAMEASREPORT [LJ OTIC USERS Unclassified 
Ranjan Mukherjee (408) 646-2632 ME/Mk 


DD FORM 1473, 84 MAR 83 APR edition may be used until exhausted SECURITY CLASSIFICATION OF THIS PAGE 


All other editions are obsolete 


i UNCLASSIFIED 


“of He) 1 i 


\cOULOD 


Approved for public release; distribution is unlimited. 


A Surface Integral Algorithm for the Motion Planning of 
Nonholonomic Mechanical Systems 


by 
David P. Anderson 
Captain, United States Army 
B.S., United States Military Academy, 1983 


Submitted in partial fulfillment 
of the requirements for the degree of 


MASTER OF SCIENCE IN MECHANICAL ENGINEERING 
from the 


NAVAL POSTGRADUATE SCHOOL 
| tie. December 1992 


ABSTRACT 


The number of coordinates needed to completely describe the configuration of a 
holonomic mechanical system is equal to the number of degrees of freedom possessed 
by that system. In contrast, nonholonomic systems always require more coordinates 
for their description than their are degrees of freedom due to the nonintegrable nature 
of the governing velocity constraints. The task of nonholonomic motion planning 
applied to a given system is to develop trajectories of the independent coordinate 
variables such that the entire system is driven to some desired point in its config- 
uration space. An algorithm for constructing these trajectories is presented. In 
this algorithm, the independent variables are first converged to their desired values. 
The dependent variables are subsequently converged using closed trajectories of the 
independent variables. The requisite closed trajectories are planned using Stoke's 
Theorem which converts the problem of finding a closed path in the space of the 
independent variables to that of finding a surface area in that same space such that 
the dependent variables converge to their desired values as the independent variables 
traverse along the boundary of the surface area. The use of Stoke’s Theorem simpli- 
fies the motion planning process and also answers important questions pertaining to 
the system. The salient features of the algorithm are apparent in the two examples 


discussed: a planar space robot and a disk rolling without slipping on a flat surface. 
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I. INTRODUCTION 


This thesis presents an algorithm for planning the motion of nonholonomic me- 
chanical systems. The algorithm provides a means for calculating the coordinate 
trajectories required to drive a nonholonomic system from one point in its configu- 
ration space to some other desired point. The algorithm involves the use of Stoke’s 
Theorem and therefore takes a surface integral approach to the problem. To enhance 
the reader’s understanding of the algorithm, the discussion proceeds methodically. 
The goal of this first chapter is to clarify the nonholonomic motion planning problem 
and provide a conceptual overview of the surface integral approach to its solution. 
Chapter II. begins with a review of the mathematical details needed for a complete 
understanding of the algorithm, follows with a detailed discussion of the algorithm 
itself, and concludes with some notes on some of its more versatile features. In 
Chapter III., the surface integral algorithm is applied to two simple nonholonomic 
mechanical systems: a planar space robot and a disk rolling without slipping on a 
flat surface. These examples serve to validate the algorithm and, hopefully, solidify 
the reader’s understanding of it. Finally, a summary is provided in Chapter IV. It is 
hoped that this methodical approach will provide the reader with an appreciation for 
the simplicity and utility of the surface integral algorithm for the motion planning of 


nonholonomic mechanical systems. 
A. HOLONOMIC VERSUS NONHOLONOMIC SYSTEMS 


The description of mechanical systems begins with a suitable choice of coordinates 
and an identification of the constraints of motion resulting from that choice. In 
the case of holonomic mechanical systems, coordinates can be chosen such that no 


l 


motion constraints arise. When the coordinates are chosen such that constraints of 
motion do arise, those constraints always entail a relationship between the coordinates 
themselves and not their derivatives. In contrast, nonholonomic mechanical systems 
always require constraints of motion to complete their description regardless of how 
the coordinates are chosen. This is because at least one of the constraints will involve a 
non-integrable relationship between the first derivatives of the coordinates. To further 
illustrate the difference between holonomic and nonholonomic mechanical systems, 
consider the two systems shown in Figs.1l(a) and 1(b). 

Figure l(a) shows two particles m; and m2 connected by a rigid, massless rod of 
length (fj +/2) on a two dimensional z-y plane. The center of mass of the system is 
shown. An infinite number of coordinate sets can be used to describe the configuration 
of this system. One choice might involve the use of the coordinates (z<, yc, 8) to specify 
the position of the center of mass of the system in the z-y plane and the orientation 
of the rod with respect to the vertical y axis. Such a choice completely describes the 
state of the mass-rod system and does not require any equations of constraint. A 
second choice of coordinate sets might involve the coordinates (z1, y1, 22, y2) to specify 
the positions of each mass in the z-y plane. Such a choice of coordinates requires the 


following constraint equation in order to completely describe the state of the system: 
(zo -21)° + (yo -—y1)? = (Ai thy)? (1) 


A third choice of coordinate sets might entail the coordinates (21, y1,22,y2, Zc, Yc) to 
specify the positions of each mass as well as the center of mass in the z-y plane. Such 
a choice of coordinates requires three equations of constraint to completely describe 


the system: 


(Ze—- 21)? + (ye-m)?=lf (2a) 


(z2 — Ze)” + (y2 — Ye)? = b5 (25) 


ys 


(z2-21)° +(yo-—s)? =( th)? (2c} 


Obviously, the possible number of coordinate sets that might be chosen to describe 
this system are endless. However, all possible coordinate sets share one common 
feature: they result in either no constraints of motion or constraints of motion which 
relate the coordinates of the system and not their derivatives. Hence, the rod-mass 
system of Fig.1(a) is a holonomic mechanical system. 

Consider now the system shown in Fig.1(b). This system consists of a disk of 
radius r rolling without slipping on the z-y plane. A set of coordinates which might 
be chosen to describe the location of a point P on the disk is (z,y,@,a) where xz and y 
describe the location of the disk’s point of contact with the ground, @ describes the 
angle a radial line through point P makes with the vertical z axis. and a describes the 
angle the disk’s instantaneous direction of motion on the z-y plane makes with the 
horizontal y axis. Such a choice of coordinates results in the following two equations 


of constraint: 


t=ré@sina (3a) 


y = rOcosa (3b) 


Note that Eqs.(3a) and (3b) above relate the derivatives of the coordinates to each 
other and not the coordinates themselves. Furthermore, since a is an independent 
function of time, Eqs.(3a) and (8b) cannot be integrated to yield relationships be- 
tween the coordinates (the conditions for nonintegrability of a differential expression 
will be discussed in Chapter II.A.1). For this reason, Eqs.(3a) and (3b) are termed 
nonholonomic constraints on the disk of Fig.1(b), and the disk itself is said to be a 
nonholonomic mechanical system. All nonholonomic mechanical systems share this 
feature: the constraints of motion relate the velocities of the system and cannot be 


integrated to yield relationships between the coordinate positions. 
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This feature of nonholonomic systems is unique and gives rise to the nonholonomic 
motion planning problem. | 
B. THE NONHOLONOMIC MOTION PLANNING PROBLEM 

In the previous section, it was shown that nonholonomic mechanical systems are 
governed by constraints of motion which involve nonintegrable relationships between 
the velocities of the system. In this section, it will be shown how this feature of 
nonholonomic systems gives rise to the nonholonomic motion planning problem. To 
understand this problem, a number of terms must first be discussed. 

The configuration space of a mechanical system is the space defined by the mini- 
mum number of coordinates needed to completely describe that system. The dimen- 
sion of the configuration space is the number of those coordinates. The degrees of 
freedom of a mechanical system is defined as the difference between the number of 
coordinates used to describe the system and the number of independent equations of 
constraint arising from that description. In more specific terms, given a mechanical 
system described by n coordinates and m independent equations of constraint, the 
number of degrees of freedom possessed by the system is equal to n-m. ‘The number 
of degrees of freedom possessed by a given system is a fixed number and is completely 
independent of the coordinate system chosen. Finally, the number of independent co- 
ordinates available to a given mechanical system is synonomous with the number of 
degrees of freedom of the system. Additional coordinates over and above this number 
are always dependent. 

Consider now the holonomic rod-mass system of Fig.1(a). Note that it is a three 
degree of freedom system since, regardless of how the coordinates are chosen, the 
number of coordinates minus the number of independent constraints is always equal 
to three. Likewise, the number of independent coordinates available to the system 
is also equal to three although for any given set of coordinates, the choice of which 
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are independent and which are dependent is both physically and mathematically 
arbitrary. Now consider the nature of the holonomic constraints described by Eqs.(1), 
(2a), (2b), and (2c). Note that because these equations all entail a direct relationship 
between the coordinates themselves, specification of the values of any three of the 
variables uniquely determines the values of any remaining variables. In other words. 
regardless of which coordinate system is chosen, specification of the values of the 
independent coordinates uniquely determines the value of the dependent coordinates. 
As a result, only the values of the independent coordinates are needed in order to 
completely specify the configuration of the system. This is true of all holonomic 
mechanical systems and because the number of independent coordinates available to 
a given system is equal to the number of degrees of freedom possessed by that system, 
the dimension of the configuration space of a holonomic system is always equal to its 


number of degrees of freedom. 


Now consider the nonholonomic rolling disk of Fig.1(b) and its accompanying 
constraint equations, Eqs.(3a) and (3b). Note that it is a two degree of freedom sys- 
tem since the number of coordinates used to describe the system minus the number 
of independent equations of constraint is equal to two. The coordinates z and y are 
clearly the dependent variables since their values can only be changed by either rolling 
or both rolling and turning the disk. Note however that the values of x and y are not 
uniquely determined by the constraint equations given the values of the independent 
variables 6 and a. This is due to the fact that the constraint equations represent non- 
integrable relationships between the velocities of the system and not the coordinates 
themselves. As a result, the values of all four coordinates must be specified sepa- 
rately in order to completely describe the configuration of the rolling disk. Unlike the 
holonomic constraint equations of the rod-mass system, the nonholonomic constraint 
equations of the rolling disk do not restrict the dimension of the configuration space 
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of the system. This is a unique feature of nonholonomic mechanical systems and 
forms the heart of the nonholonomic motion planning problem: their ability to access 
a configuration space of higher dimension than their number of degrees of freedom. 
The nonholonomic motion planning problem can therefore be stated as follows: given 
a system described by n coordinates and m nonholonomic constraints, how does one 
drive all n of the coordinates from some initial set of values to some desired set of 
values in spite of the system having only n—m degrees of freedom? The answer to 
this question has been sought by numerous researchers and a variety of solutions have 
been proposed. In the next section, a brief survey of some of these solution techniques 
will be presented. 
C. LITERATURE SURVEY 

The nonholonomic motion planning problem has been the focus of attention of 
various researchers in the recent past. Specifically, researchers have considered the 
questions of how a falling cat manages to always land on its feet [Ref. 1, Ref. 2: 
pp. 25-30] and how an astronaut might use those same principles to reorient himself 
during a spacewalk [Ref. 3]. Researchers have also considered the problems of mobile 
wheeled robot navigation [Ref. 4, Ref. 5], parking a front wheel drive car [Ref. 2: 
pp. 89-91, Ref. 6: pp. 8-11, Ref. 7: pp. 17-19], parking a cart with multiple trailers 
[Ref. 6: pp. 11-13, Ref. 7: pp. 29-30, Ref. 8], controlling a unicycle or rolling disk 
[Ref. 2: pp. 83-89, Ref. 6: pp. 6-8], controlling a satellite with rotors instead of 
gas jets [Ref. 2: pp. 21-25], dextrous manipulation with robotic fingers (Ref. 9], and 
reconfiguration of a space structure or space manipulator using only internal motion 
[Ref. 10, Ref. 11]. Each of these researchers have explored various aspects of the 
nonholonomic motion planning problem and have developed unique solutions to it. 

Kane, Headrick, and Yatteau [Ref. 3] conducted experiments to determine the 
feasibility of a spacewalking astronaut to reorient himself through arm motion only. 
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The nonholonomy of an astronaut or any freefloating spacecraft derives from the prin- 
ciple of angular momentum conservation. While these researchers did not approach 
this problem in the broad context of nonholonomic motion planning, their research 
pointed the way towards a number of possible solution techniques. 

The problem of controlling a multi degree of freedom space manipulator was first 
addressed by Vafa and Dubowsky [Ref. 11]. The dynamic coupling between the 
joints of a space manipulator and the vehicle to which it is attached often results in 
an undesirable drift of the vehicle when the joints are actuated. Vafa and Dubowsky 
proposed using small cyclic motions of the manipulator joints to control this drift. 
The problem was also tackled by Nakamura and Mukherjee [Ref. 10] who showed 
that the vehicle orientation as well as the joint angles could be brought to their 
desired configurations by executing appropriate trajectories of the joint angles. The 
trajectories were planned using a Lyupanov function and by adopting a bidirectional 
approach. 

The nonholonomic nature of a car or cart with multiple trailers evolves along the 
same lines as that of the rolling disk discussed in the previous sections. Laumond (Ref. 
8] studied the multibody car system and concluded its controllability by showing that 
the rank of the control Lie Algebra is equal to the dimension of the state space at 
every point in the state space. Murray and Sastry [Ref. 7: pp. 29-30] also studied the 
problem. They showed that the dependent variables of the system could be brought 
to their desired values by executing closed trajectories of the independent variables. 
The closed trajectories were planned using a scheme involving sinusoids. 

While the research discussed above sheds light on various aspects of the non- 
holonomic motion planning problem, none of the methods, algorithms, or concepts 


developed thus far completely solve the problem. A general scheme, applicable to a 


wide range of nonholonomic mechanical systems, has not yet been presented. Addi- 
tionally, a global scheme for addressing important questions such as motion planning 
in the presence of additional constraints, the reachability of a given system, and re- 
peatability is conspicuously absent from the literature. The surface integral algorithm 
represents a new approach. Not only is it applicable to a large class of nonholonomic 
systems, but its implementation also leads to definitive answers to the questions posed 
above. In the next section, a conceptual overview of the algorithm will be presented. 


D. OVERVIEW OF THE SURFACE INTEGRAL ALGORITHM 


To gain a basic understanding of the surface integral approach to the motion 
planning of nonholonomic systems, consider again the rolling disk, this time shown 
in Fig.2(a). Suppose it is desired that the disk change its coordinates from (z, y, 6, a) 
to (xa, ya,9,a). A very simple way of accomplishing this would be to first roll the 
disk forward along path segment AQ, and then roll the disk backwards along path 
segment OB. As shown in the figure, the end result of such a maneuver would be 
that the coordinates 8 and a remain constant while the coordinates z and y move to 
their desired values zz and yg. Such an operation involves the execution of a closed loop 
trajectory in the 6-a plane , shown in Fig.2(b), to achieve the desired change in z and 
y. In more general terms then, it appears as though it is possible for nonholonomic 
mechanical systems to achieve a desired configuration of the dependent variables 
simply by executing an appropriate closed loop path in the space of the independent 
variables. It therefore follows then, that to converge all of the configuration variables 
of a nonholonomic system from one set of values to another, one might first converge 
the independent variables from their initial values to their desired values without 
being concerned about the evolution of the dependent variables. One could then 
execute an appropriate closed loop path in the space of the independent variables to 
converge the dependent variables to their desired values. 
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The technique described above leaves one critical question unanswered. How does 
one calculate an appropriate closed loop path? The surface integral algorithm is the 
answer. In this method, the problem of finding a closed loop path in the space of 
the independent variables is transformed into the problem of determining a surface 
area in that same space such that the dependent variables converge to their desired 
values as the independent variables traverse around the boundary of the surface area. 
The required transformation is accomplished by applying Stoke’s Theorem to the 
differential form of the nonholonomic constraint equations. 

To summarize, the essential features of the surface integral algorithm for the 
motion planning of nonholonomic systems can be stated as follows: all of the config- 
uration variables of a nonholonomic mechanical system are brought to their desired 
values by first converging the independent variables and then by executing a closed 
loop path in the space of the independent variables to converge the dependent vari- 
ables. The requisite closed loop path is calculated by applying Stoke’s Theorem to 
the differential form of the nonholonomic constraint equations. 

In the next chapter, Stoke’s Theorem and other mathematical details needed for 
a full understanding of the surface integral algorithm will be reviewed. Following 
that, a detailed mathematical description of the surface integral algorithm will be 
presented. Finally, the algorithm’s ability to answer important questions pertaining 


to the system will be discussed. 


Il. THE SURFACE INTEGRAL APPROACH TO THE 
NONHOLONOMIC MOTION 
PLANNING PROBLEM 


A. MATHEMATICAL PRELIMINARIES 
1. Nonintegrability of Nonholonomic Constraints 
In Chapter I., nonholonomic constraints were described as constraints which 
involved a nonintegrable relationship between the first derivatives of the coordinates. 
An obvious question is how does one determine whether or not a given constraint is 
nonintegrable? To answer, the constraint equation must first be recast into differential 
form. Taking the constraint described by Eq.(1) for example, and differentiating with 


respect to time yields 
(ro = 1) (22 = @1) + (y2 — Viigo = i) = 9 
Rewriting in differential form and designating zz as the dependent variable yields 
(x2 — £1 )(drq — dr) + (y2 — y1)(dy2 — dy) = 0 
dey = (2 )dyp — (4 dy: + dey (4) 
rq — 2 ty — 24 
Equation (4) represents the constraint described by Eq.(1) recast into differential 
form. 


Recasting the nonholonomic constraints of the rolling disk into differential 


form is a simpler task. 
<= résina = dx = (rsina)dé@ (Sa) 


y = ré COS @ —_—- dy = (r sin a)dé (5d) 
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The above discussion helps to illustrate the fact that any set of constraint 
equations, be they holonomic or nonholonomic, can be written in the following general 


form 


Semen, de =o. j=1,2---m (6) 
t= 
where the q’s represent the generalized coordinates, t represents time, and the a's are, 
in general, functions of the q’s and t. In Eqs.(4), (5a), and (5b) the time coordinate 
does not appear explicitly. This is a property of what are termed scleronomic systenis. 
and only mechanical systems of this type will be considered in this discussion. As 
before, n represents the number of generalized coordinates used to describe the system 
and m represents the number of independent constraint equations. 
With the constraint equations in differential form, a simple test can be ap- 
plied to determine whether or not the equations are integrable. Strictly speaking, a 
differential expression is integrable if and only if it is an exact differential or can be 
converted into an exact differential by multiplying through with an integrating factor. 


In, more specific terms, it can be shown that the necessary and sufficient condition 


for the integrability of the differential expression 
vjdz + vgdy + v3dz = 0 (7a) 


where v,, v2, and v3 are continuous functions of z, y, and z in a domain D of space is 


that 
Ovq Ov3 Ov3 Ov Ov, Ovo _ 
dee ogo ie eet eee Ee) 7b 
n(Z m2) +m (F a) + (F Ox ) 
In the more general case, the necessary and sufficient condition that the differential 


constraint in n variables 


v, dz, + vgdrq +-:-+Un dz, = 0 (8a) 


ly 


is integrable is that the set of equations 


Ov,  Ovy Ov, Ovzy (f OU maou, 
z ($e ~ 5) ae Ce 7 = my (= 5 a =e 


(Nee = 1,2,5-2, (85) 








are Satisfied simultaneously and identically. [Ref. 12] 

Applying this criterion to Eq.(4) shows that this constraint is in fact integrable 
and therefore holonomic. Applying this criterion to Eqs.(5a) and (5b) shows that they 
are not integrable and therefore nonholonomic. 

2. Relevant Theorems 

In this part of the chapter, two important mathematical theorems will be 
reviewed. The first is Stoke’s Theorem used for the transformation of line integrals 
into surface integrals and vice versa. The second concerns the path independence 
of line integrals. Stoke’s Theorem will serve as the principal mathematical tool for 
determining the required closed loop path needed to converge the dependent variables. 
The theorem regarding the path independence of line integrals will be crucial to the 
demonstration that the dependent variables can in fact be driven to any desired 
configuration from any other. 

a. Stoke’s Theorem 

Let S be a piecewise smooth oriented surface* in space and let the boundary 
of S be a piecewise smooth closed curve C. Let v(z,y,z) be a continuous vector function 


which has continuous first partial derivatives in a domain in space which contains S. 


* If a surface S has a unique normal whose direction depends continuously 
on the points of S, then S is called a smooth oriented surface. If S is not smooth but 
can be subdivided into finitely many smooth portions, then it is called a piecewise 
smooth oriented surface. 
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Then 


fo veds= f fmt (V x v)dA (9) 


where n is the unit vector normal to the surface S on that side of S which is taken as 
the positive side. The positive direction along C is then defined as the direction along 
which an observer, travelling on the positive side of S$, would proceed in keeping the 
enclosed area to his left. Refer to Fig.3(a). % is the component of v in the direction 
of the tangent vector of C. [Ref. 13: p. 364] 

If the direction cosines of the unit vector n normal to the surface S are cos a, 


cos @, and cosy, and if v = v,t + v97 + 3k, then Stoke’s Theorem can be written as 


f (v, dz + vg dy + v3 dz) = 
C 


Ov3  Ov2 Ov, Ov | Ovo Ov, 
ILA Oy 72) cosa + (F#- 32) cos 3-+ (S2 - 4) cos dA (10) 


If the space under consideration is restricted to the z-y plane, then Eq.(10) simplifies 


f (ode + vady) = // (2 - St) dy Cl) 


which is essentially a statement of Green’s Theorem [Ref. 13: p. 336]. 





to the form 


For Eq.(11), the positive direction along the closed curve C is shown in 
Fig.3(b). This directly follows from Eq.(10) where the values of a, 3, and + were 
taken to be 7/2, 7/2, and 0 respectively. The direction of the closed curve C in 
Eq.(11) may be changed by using (a, @,y) = (1/2,7/2,7) in Eq.(10). This will lead to 
a change in sign of the surface integral in Eq.(11). 
b. The Path Independence of Line Integrals 
Let v = v,itv.j +u3k, and let v,, v2, and v3 be continuous functions of z, 


y, and z in a domain D of space. Then the line integral 


| (v, dx + vq dy + v3 dz) eh 2)) 
Cc 
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is independent of path if and only if the differential form under the integral sign is 
exact in D, or equivalently the integral is zero for every simple closed path in D, or 
equivalently V x v = 0 everywhere in D [Ref. 13: an 369-376]. 

From the above theorem, coupled with Eq.(10), it is clear that the necessary 
and sufficient condition for the value of the line integral in expression (12) to be 


independent of the path C is that 


Ov2 _ OV3 Ov3 Ov, Ov; _ Ovo 


dz Oy’ Ox Oz" Oy Ox 





B. THE SURFACE INTEGRAL ALGORITHM 

In Chapter I.D.. a conceptual overview of the surface integral approach to the 
motion planning of nonholonomic systems was presented. With the mathematical 
details necessary for a complete understanding of the algorithm now covered, a more 
detailed treatment of the method is in order. It should be noted that the algorithm is 
best illustrated through the use of appropriate examples. This will be the subject of 
Chapter III. At this point however, it is well worth the effort to discuss the theoretical 
and mathematical basis of the algorithm. 

Consider now a nonholonomic system where one of the dependent variables is p 


and is constrained by the nonholonomic differential expression 


dp = v,dzr + vody (14) 


where z and y are taken to be the independent variables and x, and v2 are general 
functions of zx and y. 


If an attempt is made to integrate Eq.(14) along some closed curve C in z-y space 


J dp= f (ride + dy) (15) 


it is clear that the attempt would be a failure since nonholonomic constraints are, 
by definition, nonintegrable. However, since the expression on the right hand side of 
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Eq.(14) is not integrable, it is therefore not exact. It follows then, from the discussion 
on the path independence of line integrals, that if such a curve C could be found and 
the integration performed, the resulting change in p would be dependent on the nature 
of C. In other words, the evolution of the dependent variable p as the independent 
variables x and y traverse a closed loop path in z-y space is entirely dependent on the 
shape of that path. It seems then, that a desired change in the value of the dependent 
variable p could be affected by choosing an appropriate path C in z-y space about 
which the independent variables z and y traverse. The obvious question is how might 
this path be chosen given the nonintegrable nature of Eq.(15). 

At this point, Stoke’s Theorem comes to the rescue. Suppose the desired change 
in p is given by Ap. Then, using Stoke’s Theorem (in the simplified form of Green’s 


Theorem), Eq.(15) can be recast into the following form: 


f a f (vijdz + vady) = II (= - > | azday = Ap (16a) 
C C s\ Or dy 


If the double integral of Eq.(16a) can be evaluated, then the problem of determining 
the appropriate closed curve C is reduced to finding a surface area S in which the 
curve C is defined by the outline of this surface area. The integration problem can be 
simplified by choosing this surface area to be rectangular in shape with sides parallel 


to the z and y axis. Placing limits on the double integral of Eq.(16a) results in 


haa Ov2 Ov; 
ap / / (= - ) dxdy (165) 
ae Ox Oy 


where xz, and zr, represent the lower and upper limits of the rectangle along the z 
axis and y, and y, represent the lower and upper limits of the rectangle along the 
y axis. A simple way of solving this problem thus involves performing the double 
integration dictated by Eq.(16b), choosing three of the four required limits based 
on the physical considerations of the problem, and solving the resulting algebraic 
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expression for the fourth and final limit. With this information in hand, the closed 
curve C can be constructed and the independent variables z and y caused to traverse 
around it to produce the desired change in p. As stated in Chapter I.D., the complete 
surface integral algorithm involves first moving the independent variables to their 
desired values noting the resulting final values of the dependent variables and then 
calculating an appropriate closed loop path in the space of the independent variables, 
using the method described above, such that the desired change in the values of the 
dependent variables is brought about. 

This is the surface integral algorithm for planning the motion of nonholonomic 
systems. Its utility and ease of implementation is demonstrated via the examples to 
be discussed in Chapter III. Before proceeding to those examples however, it is worth 
noting some of the more salient features of the algorithm. 

C. NOTES ON THE VERSATILITY OF THE SURFACE INTEGRAL 

ALGORITHM 

The surface integral algorithm provides a simple and effective means of deter- 
mining the trajectories required to drive all of the configuration variables of a non- 
holonomic mechanical system to their desired values. The following features of the 
algorithm make it particularly attractive. 

1. Location of the Closed Trajectory in the Space of the Independent 

Variables 
Once again, consider a nonholonomic system where one of the dependent vari- 


ables is p and is constrained by the nonholonomic differential expression 
dp = v}dz + vody + v3dz (17) 


where z, y, and z are taken to be the independent variables and v, v2, and v3 are gen- 
eral functions of z, y, and z. Assume now that there exists some closed trajectory C of 
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the independent variables z, y, and z that produces a change in the dependent variable 
p by some desired amount Ap. If (zo, yo, zo) is any point on this closed trajectory, and 
if the initial configuration of the system is (zo, yo, 20, po), then after the system moves 
along C once, its configuration will be (zo, yo, z0,po + Ap). Refer to Fig.4(a). If the 
closed curve C was traversed in the opposite direction, then the final configuration of 
the system would have been (z9. yo, 20,290 — Ap). Now consider the initial configuration 
of the system to be (2’, y’, z’, po) such that (x’,y’, z’) does not lieon C. Let P be any path 
segment connecting the point (z’,y’,z’) and a point (zo, yo, z0) on the closed curve C. 
Refer to Fig.4(b). Let ép denote the change in the dependent variable p as z, y, and z 
move along the path segment P from (z’, y’, z’) to (zo, yo, 20). Then, if the system moves 
from the initial configuration (z’, y’, z’,po) to the closed curve C, traverses the closed 
curve C once, and finally retraces the path segment P backwards, the configuration 
of the system at the end of the path will be (z’,y’,z’,p9 + Ap). This is true because 
the surface integral of the area bounded by the closed curve beginning and ending at 
the point (z’,y’,z’) is equal to the surface integral of the area bounded by the closed 
curve C. From this discussion, it follows that the closed curve C that can bring about 
the desired change in the dependent variable can lie anywhere in the space defined 
by the independent generalized coordinates - it does not have to pass through the 
initial configuration of the system. This feature of the surface integral algorithm is 
extremely useful and will prove its worth in the example systems to be dicussed in 
Chapter III. 


2. Motion Planning in the Presence of Additional Constraints 


Often times, mechanical systems are subjected to constraints of motion over 
and above those arising from the choice of coordinates. Obstacles in the workspace 
provide the most salient example. The rolling disk of Figs.1(b) and 2(a) for instance, 
might have its allowed motion restricted by a wall or similar obstacle. The motions 
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of a robot on an automobile assembly line must be planned so as to avoid inadvertent 
contact with the cars it is operating on. In order to be effective, a motion planning 
algorithm must allow for the generation of admissible trajectories in the presence of 
additional constraints. With regard to nonholonomic systems, the surface integral 
algorithm provides just such a capability. This capability will be demonstrated in the 
examples of Chapter III. 
3. Algorithmic Singularity 
Virtually all motion planning algorithms, when applied to any given mechan- 
ical system, entail the possibility of mathematical singularity. An effective algorithm 
must provide a means for coping with this problem when it arises. In Chapter III.. 
the ability of the surface integral algorithm to deal with mathematical singularity will 
be readily apparent. 
4. Reachability 
The reachability of a given mechanical system can best be defined as its ability 
to arrive at any desired configuration from any other. Obviously, the reachability of 
a system is an important consideration. Implementation of the surface integral al- 
gorithm provides a means of ascertaining the reachability of a nonholonomic system. 
In Chapter III., the general method of determining the reachability of a nonholo- 
nomic system will be discused and the method demonstrated via the examples of 
that chapter. 
5. Repeatability 
The basis of the surface integral algorithm derives from the fact that closed 
trajectories of the independent variables result in a change in the values of the de- 
pendent variables. In particular situations however, it may be desirable to find closed 
trajectories of the independent variables that result in no net change of the dependent 
variables. Motion of this type is termed repeatable motion due to the fact that all of 
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the coordinate variables return to their original values upon completion of the mo- 
tion. Robots programmed to perform repetitive tasks (such as automobile welding) 
for example, must be capable of repeatable motion in order to perform the same task 
over and over again. While the issue of repeatability is theoretically trivial in the case 
of holonomic systems, such is not the case for nonholonomic systems. In Chapter III, 
it will be demonstrated that the trajectories needed to produce repeatable motion in 
a nonholonomic mechanical system can be generated easily through application of 
the surface integral algorithm. 

Thus far, this paper has presented a description of nonholonomic mechanical 
systems and the nonholonomic motion planning problem, the mathematical basis of 
the surface integral algorithm for solving the nonholonomic motion planning prob- 
lem, and a discussion of the surface integral algorithm itself. Additionally, the various 
attractive features of the algorithm have been briefly described. In the next chapter, 
the algorithm will be applied to two simple nonholonomic systems: a two dimensional 
free flying space robot and the rolling disk of Figs.1(b) and 2(a). These two exam- 
ples will demonstrate the exceptional utility, simplicity, and versatility of the surface 


integral algorithm. 
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Ill. APPLIED EXAMPLES OF THE SURFACE 
INTEGRAL ALGORITHM 


A. THE PLANAR SPACE ROBOT 

In this part of Chapter III., the surface integral algorithm for the motion planning 
of nonholonomic systems will be illustrated through the example of a free flying, two 
dimensional space robot. The robot consists of two links mounted on a space vehicle 
as shown in Fig.5. Such a system can be described by five coordinates: zg, yo, and 6 
representing the position of the center of mass and the orientation of the space vehicle, 
and 6, and 6) representing the joint angles of the manipulator. The requirement that 
the linear momentum of the system be conserved leads to two holonomic constraints of 
motion while angular momentum conservation leads to one nonholonomic constraint. 
Because the system is described by five coordinates and three equations of constraint, 
the planar space robot possesses two degrees of freedom. 

The holonomic constraints that arise due to the conservation of linear momen- 
tum allow for the elimination of the variables zo and yo from the kinematic equations 
describing the system. The nonholonomic constraint however, does not allow for the 
elimination of any of the variables due to the fact that it consists of a nonintegrable 
relationship between the derivatives of the remaining coordinates, namely 6, 6, and 
6,. The entire system is therefore completely described by three generalized coordi- 
nates (89, 6;, 8.) and one nonholonomic constraint equation due to the conservation of 
angular momentum. With some effort, this nonholonomic constraint equation can be 


derived and is found to be given by the relation 


d. = = (a6: + b62) (18) 
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where, 


Aol ] ] ] | 
A= ue + my)?l? ale mata — (mo + myn cos 6. — M (1 + (yes +. m)l? + mall 
a=—-A—M Ip 

A l t ] ] ] 
b =ahed (1a-+ Limall + mall cosd — zmgzlo -— sma(5m1 + m2)lyl2 cos Ay (19) 


and where mo, m; and m2 are the masses of the space vehicle and the two links; Jo, J, 
and Jy are the moments of inertia of the space vehicle and the two links about their 
center of masses; /; and ly are the length of the two links; and M = (mp +m; +m») and 
7 — (p+ 1, + Jo). 

The physical effect of the nonholonomic constraint described by Eq.(18) is that the 
orientation of the space vehicle, 60, drifts when the joints are activated. Because the 
amount of drift is directly dependent on the motion of the joints, @ is the dependent 
variable in the system. The nonholonomic motion planning task is therefore to develop 
trajectories of the independent variables 6; and 6, which drive the entire system to 
some desired configuration. In accordance with the procedure described in Chapter 
II.B., this will be accomplished by first converging the joint angles to their desired 
values. The orientation of the vehicle will then be converged by executing closed 
trajectories of the joints. These closed trajectories will be planned using Stoke's 


Theorem. 


Let the arbitrary initial and desired configurations of the robot be denoted by 
(01,411,421) and (807,917,427) respectively. Upon initial convergence of the independent 
variables 6,; and 6); to their desired values 6;, and 62;, let the orientation of the 
space vehicle drift from 69; to some intermediate value 64. The task then is to use 
Stoke’s Theorem to plan a cyclic motion for the joints of the manipulator such that 
the orientation of the space vehicle changes from 604 to #0¢ while the joint angles come 
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back to their desired configuration. Rewriting Eq.(18) in differential form yields 


dy = X (add, + b db.) (20) 


Integrating Eq.(20) about a closed curve C in the 6,-62 plane and applying Stoke’s 


Theorem in the form given by Eq.(11) yields 


boy ~ boa = fin = $ ( 5 db, x0) = Lf. ae = )- Se) d8,d0, (21) 


where S is the surface in the @,-4 plane confined within the closed curve C. Substi- 
tution of the expressions for a, 6, and A from Eq.(19) and specification of the surface 


S as a rectangle with sides parallel to the 6, and 4 axis leads to 


G2u 1 Oo 
6 eal 8 = M 
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and where 6,, and 6,, denote the lower and upper extremities of @; in the rectangular 
path while 6); and 62, denote the same for 62. Finally, performing the combined 


differentiation and integration dictated by Eq.(22) yields 


Ao l l 
a pe ee eee 24 
n SOE iat) A+Bcos6), A+B cos@, ot 


where 


80 = Oor — 9a 


and n equals the desired number of cyclic motions about the closed loop trajectory. 
Clearly, for a desired change in 4 (given by @), an appropriate closed loop tra- 
jectory of the joint variables 6; and 6) can be constructed simply by specifying the 
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trajectory to be rectangular in shape and choosing values of @1;, 4:4, 42:, and @), such 
that Eq.(24) is satisfied. 

To illustrate, consider a robot with the following kinematic and dynamic param- 
eters: mo = 27.44 kg, m, = 5.38 kg, mg = 2.64 kg, Ip = 1.520 kgm?, J, = 0.115 kgm?, 
I, = 0.028 kgm?, |; = 0.50 m, and ly = 0.35 m. Let the initial configuration of the 
system be (4o:, 41,, 42) = (0.0, 15.0, 15.0) degrees and the final desired configuration be 
(807,917, 827) = (—20.0, 45.0,0.0) degrees. Furthermore, specify that the desired change 
in the dependent variable 6 occur only after three complete cycles of the closed loop 
trajectory. Using computer simulation, the independent variables @, and 6 are first 
converged from their current values to their desired values by following the straight 
line trajectory OA shown in Fig.6(a). During this process, the orientation of the 
space vehicle drifts from 69, = 0.0 degrees to 4 = —12.87 degrees as shown in Fig.6(b). 
Thus, 80 = 907 — 9a = —7.13 degrees. If a cyclic motion of the joints is to be planned 
such that after three complete cycles the orientation of the space vehicle changes by 
the desired amount, then for each cycle the required change of orientation would be 
60/n = —7.13/3.0 = ~2.38 degrees. Choosing 6,; = 45.0 degrees and 4, = 0.0 degrees to 
correspond with point A of Fig.6(a) and arbitrarily choosing 6,,, = 125.0 degrees results 
in 69, = 53.4 degrees, calculated using Eq.(24). Note that all angles must be converted 
from degrees to radians prior to using Eq.(24). 

The values (611, 1u, 921, 92u) = 50 125.0, 0.0,53.4) degrees define a rectangular path 
ABCDA in the 6,-6, plane, shown in Fig.6(a), which, when traversed three times by 
the robot joints, will cause the dependent variable 4 to converge to its desired value. 
The evolution of all the configuration variables for the path OABCDA when the closed 
trajectory ABCDA is traversed three times is shown in Fig.6(b). Note that all of the 


configuration variables do in fact converge to their desired values. 
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The above example confirms the validity of the surface integral algorithm. It is 
now worth the effort to illustrate some of the more versatile features of the algorithm 
in the context of this example. 

In Chapter [I.C.2., it was noted that motion planning must often occur in the 
presence of additional constraints. Suppose now that a situation exists such that 
the following joint limit is imposed on the space robot: |@;| < 90 degrees. Clearly, 
the closed trajectory ABCDA is no longer feasible since it requires 6; to come to a 
maximum value of 6;, = 125.0 degrees. Since this value was chosen arbitrarily to begin 
with, there is complete liberty to respecify it as, say, 01, = 75.0 degrees. Taking 6,, and 
>, to have the same values as before, maintaining the requirement that three complete 
cycles of the closed loop trajectory be executed, and recalculating the value of #2, 
using Eq.(24) yields 65, = 89.2 degrees. The values (011, O14, 921, 92u) = (45.0, 75.0, 0.0, 89.2) 
degrees define a revised rectangular path AEFGA shown in Fig.7(a) which, when 
traversed three times by the robot joints, will cause the dependent variable 6 to 
converge to its desired value subject to the constraint |6,| < 90 degrees. The evolution 
of all the configuration variables for the path OAEFGA when the closed trajectory 
AEFGA is traversed three times is shown in Fig.7(b). 

Now suppose yet another constraint is imposed, namely |4| < 80 degrees. This 
constraint now renders both the paths ABCDA and AEFGA infeasible. To obtain 
a feasible path, one might choose to respecify 6, once again in order to obtain a 
suitable value for 6.,. However, there is another way. If the requirement to execute 
three cycles of the closed trajectory is lifted, one would have the freedom to choose 
any number of cycles. Choosing the number of cycles to be n = 6 and maintaining 
(811, @1u, 82r) = (45.0, 75.0,0.0) degrees yields 62, = 61.86 degrees. These values now define 
the path AHIJA shown in Fig.8(a) which, when traversed six times, will converge 
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restrict the available trajectories, it will still be possible to choose from a variety of 
paths that will produce repeatable motion. 

To illustrate this point, consider the initial configuration of the robot to again 
be (80:,91:,82:) = (0.0, 15.0, 15.0) degrees. This time however, the task is to move the 
joints from their initial configuration to some desired configuration and back to their 
initial configuration without effecting any change in the value of 6). Again choosing 
a rectangular trajectory for the joint variables and substituting the condition that 


Oo, + 0a, = 2m (letting n =1), recasts Eq.(24) into the following form: 


l l 


ee tee) ee a oe 
0 [1 (8, 1) A+ Bcos@, A+ Bcos(2m — 6,) 


(27) 


If the desired configuration of the joints is given by (617, 627) = (60.0, 30.0) degrees, and 
(O1u,99.) are chosen to be (60.0,30.0) degrees, then 6; is calculated to be 27 — 30.0 = 
330.0 = —30.0 degrees. Choosing 6,, to be 15.0 degrees so that the initial configuration 
of the system lies on the planned closed loop path results in the trajectory OAKLA[O 
shown in Fig.9(a). Assume now that the joints must perform the required task five 
times, each time moving from point O to point L and back again to O. The evolution of 
all the configuration variables as this is accomplished over the path OAK LMO is shown 
in Fig.9(b). Note that the motion is completely repeatable. All of the configuration 
variables, including the vehicle orientation 69, return to their initial values following 
each execution of the closed trajectory OAKLMO. 

In this first part of Chapter IIJ., the surface integral algorithm was applied to 
the motion planning of a planar space robot. The example illustrated the validity 
of the algorithm as well as its ability to handle additional motion constraints. The 
example also demonstrated how the algorithm can be used to ascertain a particular 
system’s reachability. Finally. the algorithm was used to plan trajectories which result 
in repeatable motion of all the coordinates. In Chapter III.B., the algorithm will be 
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applied to yet another nonholonomic system, the rolling disk. This example will 
demonstrate the algorithm’s ability to avoid cases of singularity and will prove that 
the closed trajectory needed to converge the dependent variables can lie anywhere in 
the space of the independent variables. 
B. THE ROLLING DISK 

In this part of Chapter III., the surface integral algorithm will be applied to the 
motion planning of the rolling disk first mentioned in Chapter I.A.. This example 
will serve to further illustrate the algorithm itself as well as the algorithm’s ability to 
handle cases of algorithmic singularity. 

As discussed previously, the configuration of the rolling disk of Figs.1(b) and (2) 


can be described by the coordinates (z, y, @,a) and the differential motion constraints 
az — fsa (28a) 


dy =rcosa d@ (285) 


where z and y represent the dependent variables while 6 and a are taken as the 
independent variables. To plan a path from some initial configuration (z,,y,,@,,a,) to 
some desired configuration (xy, ys,s,a,7), the surface integral algorithm requires that 
the independent variables first be converged to their desired values as the dependent 
variables evolve to some intermediate configuration (za,ya). A closed path in the 
space of the independent variables is then planned using Stoke’s Theorem such that 
the dependent variables converge from (za, ya) to (zs, yr) aS the independent variables 
travel along this closed path. Let C be such a closed path in the 6-a plane. Then the 


change of the variables z and y as 6 and a traverse this path is given by 
ty—tg= $ rsina dd = [ | —rcosa ao da (29) 
Cc S 


vy -va= fp reosa di= | | rsina dé da (30) 
C S 
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the dependent variable # subject to the constraints |#;| < 90 degrees and |62| < 80 
degrees. The evolution of the configuration variables for the path OAHIJA is shown 
in Fig.8(b). 

The above examples illustrate that using the surface integral algorithm to plan 
the closed trajectory of the independent variables needed to converge the dependent 
variable in the presence of additional constraints is a relatively trivial problem. One 
need only choose an appropriate value of 6,, or an appropriate number of cyclic 
motions of the joints. This feature of the surface integral algorithm is extremely 
powerful and gives it a distinct advantage over other nonholonomic motion planning 


algorithms. 


Another attractive feature of the surface integral algorithm that can be demon- 
strated using the two dimensional space robot is its ability to prove the reachability 
of specific nonholonomic systems. The reachability of the space robot can be proven 
by showing that there exists a rectangular surface in the @,-@) plane defined by the 
points (411, O1u, 42,92.) such that the equality in Eq.(22) can be satisfied for any arbi- 
trary value of 09 = 407 — 94. Note that the initial values of 6, and @ do not necessarily 
have to lie on the boundary of the rectangular surface. This follows from the dis- 
cussion of Chapter II.C.1. Also note that if the identity in Eq.(22) can be satisfied 
for some value of 4 by travelling along the boundary of the rectangle in the positive 
direction, then the same identity can be satisfied for —6) simply by travelling along 
the boundary in the negative direction. Finally, if the identity can be satisfied for 
some value of 69 by travelling once along the boundary of the rectangle, then the 
identity can be satisfied for the value n@, n = 1,2,---, by travelling n times along the 
boundary in the same direction. Clearly, the reachability problem thus reduces to 
showing that the identity in Eq.(22) can be satisfied for any value of 4 € {0,«) where 
« is some small positive number. Consider the following quantity from Eq.(24): 
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[f 62, and 62, are chosen in such a manner so as to ensure that a does not equal zero, 
Eq.(24) can be rewritten as follows: 
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With this formulation, it is quite obvious that (41, - 4::) can be chosen such that 
Eq.(26) is satisfied thus proving that Eq.(22) can be satisfied for any value of 5 € (0, €). 

A final feature of the surface integral algorithm that can best be illustrated with 
the space robot concerns the problem of repeatability. In Chapter II.C.5., it was 
stated that the surface integral algorithm allowed for the calculation of trajectories 
needed to produce repeatable motion. In particular situations, a space robot may 
be expected to perform a repetitive task. In such a situation, the end effector of 
the robot as well as its configuration variables will all have to move along closed 
trajectories. If the joints of the robot shown in Fig.5 move along closed trajectories, 
the dependent variables zo and yo will always move along closed trajectories because of 
the holonomic nature of the linear momentum constraints. The dependent variable 4 
will however not move along a closed trajectory in the general case. If the net change 
in 8) were also to be zero as the joints moved along a closed rectangular path, then 
from Eq.(24) the necessary conditions that would have to be satisfied are 61, = 61 or 
cos 69, = cos 9q,. The first condition leads to the trivial case where the first joint of the 
robot will have to be kept fixed. The second condition states that repeatability is 
assured as long as 69, + 69; = 2nz, n = 0,+1,+2,---. The examples considered thus far 
demonstrate that a significant amount of flexibility exists with regard to choosing the 
closed trajectories. Although the condition 62, + 62; = 2n7, n =0,+1,+2,--- will greatly 
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where Stoke’s Theorem, in the simplified form of Eq.(11), was applied to convert the 
line integrals into surface integrals. S is therefore the surface in the 6-a plane enclosed 
by the closed curve C. Specification of this surface as a rectangle with sides parallel 


to the 6 and a axis leads to 
Qa oe 
ry-2y=- | | rcosa dé da = —r(6, — 9:)(sina, — sin a;) (318) 
al 6; 


Cie Oo 
Ye —Ya = ¥ | rsina dé da = —r(6, — 4)(cos a, — cos a) (32) 
Ql 6: 


where 6, and 6, denote the lower and upper extremities of @ in the rectangular path, 
and a, and a, denote the same for a. Eqs.(31) and (32) can be simplified by letting 


b=a, —a and a=6, —9,. With these substitutions, Eqs.(31) and (32) become 
Tid — [sin(b te ay) — sin a | iso) 


UF —-Vdq=— -ra [cos(b + ay) = COS a] (34) 


Simplification through the use of trigonometric identities yields 


b b 
Zp — Lg = —2racos(q; + 5) sin 5 coo) 
b. . 5b 
yf — Ya = 2rasin(a; + a se 5 (36) 


To construct a closed loop path in the 6-a plane that will serve to converge the 
dependent variables from (zz,y¢) to (zy,ys), one merely needs to choose a and solve 


Eqs.(35) and (36) simultaneously for a and 6 to obtain 


—= 


b = 2(—a, + arctan 2(yy — ya, 2a —Zy)], rab 47 (37) 


_ {(xy — 24)? + (yy — ya)? }'* (38) 


7 2r sin(b/2) 
Since the solutions to the arctan2 function differ by an angle of 27, 6 in Eq.(37) 
can always be chosen to be a positive number subject to 6 < 47. Furthermore, Eq.(37) 
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was derived from Eqs.(35) and (36) with the assumption that asin(b/2) is a positive 
number. Thus, in Eq.(38), the positive square root of the numerator on the right hand 
side is always chosen rather than the negative. This may sometimes lead to negative 
values of a. In such situations, the path is constructed as though a were positive and 
then is traversed in the direction opposite to normal convention. A generic closed 
rectangular path PQRSP with sides of length a and 6 as well as the required initial 
path OP needed to converge the independent variables is shown in Fig.10(a). In this 
figure, a, has been chosen to be equal to ay. 

At this point, it is worth noting that as the disk moves along the sides QR and 
SP of the rectangular path PQRSP in Fig.10(a), the value of a must change in the 
absence of rolling. Since this might be difficult to achieve in practice, such as in 
the case of a unicyclist, the rectangular path PQRSP can be modified to the path 
PQMNP shown in Fig.10(b). It is a simple matter to show that the surface integrals 
in Eqs.(29) and (30) will have the same value for each of these paths. As a result, 
the path PQMNP produces the same change in the values of the dependent variables 
xz and y as the original path PQRSP. The path PQMNP requires a to change only 


when the disk is rolling and is therefore a more physically feasible path. 


Consider now a disk of radius r = 0.25 meters at an initial configuration of 
(x1, yi, 9,,a,) = (0.0,0.0,0.0,0.0) meters, degrees. Suppose that the desired configura- 
tion of the disk is (zy, ys, 05, a¢) = (1.0, 1.0, 180.0, 30.0) meters, degrees. The independent 
variables 9 and a are first converged to their desired values using the straight line 
path OP shown in Fig.11(a). The values of the dependent variables z and y at the 
end of this path, obtained via computer simulation, are zg = 0.20 meters and yq = 0.75 
meters as shown in Fig.11(b). Choosing a rectangular path with a = ay = 30.0 de- 
grees and solving for the values of a and 6 using Eqs.(37) and (38) results in a = 130.4 
degrees and b = 265.3 degrees. A slight modification to this path using a value of 
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3B = 45.0 degrees in order to allow the value of a to change only while the disk is 
rolling results in the closed path PQRSP, also shown in Fig.11(a). Execution of this 
path results in the dependent variables evolving from (zg, ya) = (0.20,0.75) meters to 
(xs, ys) = (1.0, 1.0) meters while the independent variables change but finally return to 
values of (6;,a,/) = (180.0, 30.0) degrees. Fig.11(b) shows the actual path of the disk in 
the z-y plane. 

The above example illustrates the validity of the surface integral algorithm when 
applied to the rolling disk. However, consider Eq.(38) once again. Note that an 
algorithmic singularity will occur if 6 = 2n7, n=0,1,2,---. Substituting this value of 6 
into Eq.(37) reveals that the surface integral algorithm, as discussed thus far, breaks 


down if a,, the lower value of a on the requisite closed trajectory, has value 
a, = arctan 2 (ys — ya, Za — Tf) — NT, N= Ol 2a (39) 


As stated in Chapter II.C.3., the surface integral algorithm is equipped to handle 
such a case. In Chapter II.C.1, it was noted that the closed trajectory of the indepen- 
dent variables needed to converge the dependent variables could lie anywhere in the 
space of the independent variables. It does not have to pass through any particular 
configuration of the system. As a result, a; can be chosen arbitrarily and if by chance 
that choice results in the equality of Eq.(39) being satisfied, one merely needs to make 
another choice. 

Once again, consider a disk with radius r = 0.25 meters and an initial configuration 
(x:,4:,9,, @:) = (0.0,0.0,0.0,0.0) meters, degrees. This time, let the desired configuration 
of the disk be (zy, y;, 9s, ar) = (—0.4, 1.0, 180.0, 22.5) meters, degrees. As before, the in- 
dependent variables are first converged to their desired values, this time along the 
path OT of Fig.12(a). The values of the dependent variables (again obtained via com- 
puter simulation) evolve from (z,,y,) = (0.0,0.0) meters to (za, ya) = (0.15,0.77) meters 
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as @ and a traverse this path. If a; were chosen to be equal to a; as before, Eq. 
(39) would be very nearly satisfied and the required value of a needed to converge 
the dependent variables would be inordinately large as evident from Eq.(38). As a 
result, a: is not chosen to be equal to ay but is instead chosen (arbitrarily) as a; = 10.0 
degrees. Such a choice results in the current configuration of the system not lying 
on the closed trajectory needed to converge the dependent variables. The disk must 
therefore traverse the path segment TU of Fig.12(a) in order to arrive at the start of 
the requisite closed trajectory. This motion results in the dependent variables evolv- 
ing from (za, ya) = (0.15,0.77) meters to (z/,,y/,) = (0.32, 1.33) meters. A check of Eq.(39) 
reveals that with a = 10.0 degrees, the disk is no longer near a singular configuration. 
As aresult, Eqs.(37) and (38) can now be solved for a and 6 yielding values of a = 305.2 
degrees and b = 26.0 degrees. Note that the values of x, and y), were not considered 
when solving for a and 6 since the change in the values of the dependent vanables 
[(z’, — za) and (y/, — ya)| in traversing the path segment TU will be negated when that 
same path segment is executed in reverse. The complete closed path TUVWXUT, 
shown in Fig.12(a) and modified as before with a value of 3 = 45.0 degrees, results in 
the convergence of the dependent variables from their intermediate configuration of 
(Za, ya) = (0.15,0.77) meters to their final desired values of (z;,ys) = (—0.4, 1.0) meters. 
Because the path is closed in the 6-a plane, the independent variables return to their 
desired values of (6;, ay) = (180.0, 22.5) degrees. Fig.12(b) shows the actual path of the 
disk in the z-y plane. 

The two rolling disk motion planning problems described above once again demon- 
strate the validity of the surface integral algorithm. Additionally, in the process of 
showing that algorithmic singularities can be easily overcome, it was demonstrated 
that the closed path needed to converge the dependent variables can lie anywhere in 


the space of the independent variables. 
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IV. SUMMARY AND RECOMMENDATIONS 


In this thesis. an algorithm for calculating the coordinate trajectories required to 
drive a nonholonomic mechanical system from one point in its configuration space 
to another has been presented. The algorithm entails first driving the independent 
variables to their desired values. Closed trajectories of the independent variables 
are then executed in order to drive the dependent variables to their desired values. 
Stoke’s Theorem is employed to convert the problem of finding an appropriate closed 
path in the space of the independent variables to one of finding a surface area in 
that same space such that the dependent variables converge to their desired values 
as the independent variables traverse along the boundary of this surface area. The 
algorithm is conceptually simple and applicable to a large class of nonholonomic me- 
chanical systems. The requisite closed trajectories are not restricted to any particular 
location in the space of the independent variables, the algorithm allows for motion 
planning in the presence of additional constraints, algorithmic singularities are easily 
overcome, and questions pertaining to the reachability and repeatability of the sys- 
tem are readily answered. Application of the algorithm to two simple nonholonomic 
mechanical systems, a planar space robot and a disk rolling without slipping on a flat 
surface, demonstrate the validity and utility of the algorithm. 

The application of this algorithm to other, more practical nonholonomic motion 
planning problems is a logical next step. An actual three dimensional space structure 
might be considered. Cyclic motions of the joints of a manipulator attached to the 
structure could be used to control the attitude of the structure itself. These cyclic 
motions could be planned using the surface integral approach. This method of con- 
trolling the structure would result in significant reductions in cost and weight since 
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the requirement for fuel consuming thrusters would be minimized. The algorithm 
might also be applied to the motion planning of a wheeled mobile robot or robotic 
hand with dextrous fingers. Additionally, it may even prove useful in controlling the 
orientation of certain underwater vehicles. In summary, the surface integral algo- 
rithm provides a new and useful approach to the motion planning of nonholonomic 


mechanical systems and offers a wide range of possibilities for its implementation. 
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Figure 5. A two-link manipulator mounted on a space vehicle 1s descmbed 
by three generalized coordinates: 9,, 8,, 9,. The center of mass or the 
space vehicle nas the coordinates xy, y,. 
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